/*  
 *  ------ [ZB_05b] - receive broadcast packets  -------- 
 *  
 *  Explanation: This program shows how to receive packets with 
 *  XBee-ZigBee modules. The packets received were broadcast
 *  
 *  Copyright (C) 2012 Libelium Comunicaciones Distribuidas S.L. 
 *  http://www.libelium.com 
 *  
 *  This program is free software: you can redistribute it and/or modify 
 *  it under the terms of the GNU General Public License as published by 
 *  the Free Software Foundation, either version 3 of the License, or 
 *  (at your option) any later version. 
 *  
 *  This program is distributed in the hope that it will be useful, 
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of 
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the 
 *  GNU General Public License for more details. 
 *  
 *  You should have received a copy of the GNU General Public License 
 *  along with this program.  If not, see <http://www.gnu.org/licenses/>. 
 *  
 *  Version:           0.1 
 *  Design:            David Gascón 
 *  Implementation:    Yuri Carmona
 */

#include <WaspXBeeZB.h>

// variable to store source's network address
uint8_t source_address[8];



void setup()
{  
  // init //USB port
  //USB.ON();
  //USB.println(F("ZB_05b example"));
  
  //////////////////////////
  // 1. init XBee
  //////////////////////////
  xbeeZB.ON();
  
  delay(3000);
   
  //////////////////////////
  // 2. check XBee's network parameters
  //////////////////////////
  checkNetworkParams();
   
}


void loop()
{   
  // check available data in RX buffer
  if( xbeeZB.available() > 0 ) 
  {
    // parse information
    xbeeZB.treatData(); 

    // check RX flag after 'treatData'
    if( !xbeeZB.error_RX ) 
    {
      // check available packets
      while( xbeeZB.pos>0 )
      {
        //USB.println(F("\n\nNew packet received:")); 
        //USB.println(F("---------------------------"));
        
        /*** Available info in 'xbeeZB.packet_finished' structure ***/
        source_address[0]=xbeeZB.packet_finished[xbeeZB.pos-1]->macSH[0];
        source_address[1]=xbeeZB.packet_finished[xbeeZB.pos-1]->macSH[1];
        source_address[2]=xbeeZB.packet_finished[xbeeZB.pos-1]->macSH[2];	
        source_address[3]=xbeeZB.packet_finished[xbeeZB.pos-1]->macSH[3];
        source_address[4]=xbeeZB.packet_finished[xbeeZB.pos-1]->macSL[0];
        source_address[5]=xbeeZB.packet_finished[xbeeZB.pos-1]->macSL[1];
        source_address[6]=xbeeZB.packet_finished[xbeeZB.pos-1]->macSL[2];	
        source_address[7]=xbeeZB.packet_finished[xbeeZB.pos-1]->macSL[3];

        //USB.print(F("source_address: "));
        //USB.printHex(source_address[0]);
        //USB.printHex(source_address[1]);
        //USB.printHex(source_address[2]);
        //USB.printHex(source_address[3]);
        //USB.printHex(source_address[4]);
        //USB.printHex(source_address[5]);
        //USB.printHex(source_address[6]);
        //USB.printHex(source_address[7]); 
        //USB.println();      

        //USB.print(F("Data: "));             
        for( int i=0 ; i < xbeeZB.packet_finished[xbeeZB.pos-1]->data_length ; i++)          
        {           
          //USB.print(xbeeZB.packet_finished[xbeeZB.pos-1]->data[i],BYTE);          
        }
        //USB.println(F("\n---------------------------"));        

        // free memory
        free(xbeeZB.packet_finished[xbeeZB.pos-1]);
        xbeeZB.packet_finished[xbeeZB.pos-1]=NULL; 

        // decrement the received packet counter
        xbeeZB.pos--; 
      }
    }
  }
} 




/*******************************************
 *
 *  checkNetworkParams - Check operating
 *  network parameters in the XBee module
 *
 *******************************************/
void checkNetworkParams()
{
  // 1. get operating 64-b PAN ID
  xbeeZB.getOperating64PAN();

  // 2. wait for association indication
  xbeeZB.getAssociationIndication();
 
  while( xbeeZB.associationIndication != 0 )
  { 
    delay(2000);
    
    // get operating 64-b PAN ID
    xbeeZB.getOperating64PAN();

    //USB.print(F("operating 64-b PAN ID: "));
    //USB.printHex(xbeeZB.operating64PAN[0]);
    //USB.printHex(xbeeZB.operating64PAN[1]);
    //USB.printHex(xbeeZB.operating64PAN[2]);
    //USB.printHex(xbeeZB.operating64PAN[3]);
    //USB.printHex(xbeeZB.operating64PAN[4]);
    //USB.printHex(xbeeZB.operating64PAN[5]);
    //USB.printHex(xbeeZB.operating64PAN[6]);
    //USB.printHex(xbeeZB.operating64PAN[7]);
    //USB.println();     
    
    xbeeZB.getAssociationIndication();
  }

  //USB.println(F("\nJoined a network!"));

  // 3. get network parameters 
  xbeeZB.getOperating16PAN();
  xbeeZB.getOperating64PAN();
  xbeeZB.getChannel();

  //USB.print(F("operating 16-b PAN ID: "));
  //USB.printHex(xbeeZB.operating16PAN[0]);
  //USB.printHex(xbeeZB.operating16PAN[1]);
  //USB.println();

  //USB.print(F("operating 64-b PAN ID: "));
  //USB.printHex(xbeeZB.operating64PAN[0]);
  //USB.printHex(xbeeZB.operating64PAN[1]);
  //USB.printHex(xbeeZB.operating64PAN[2]);
  //USB.printHex(xbeeZB.operating64PAN[3]);
  //USB.printHex(xbeeZB.operating64PAN[4]);
  //USB.printHex(xbeeZB.operating64PAN[5]);
  //USB.printHex(xbeeZB.operating64PAN[6]);
  //USB.printHex(xbeeZB.operating64PAN[7]);
  //USB.println();

  //USB.print(F("channel: "));
  //USB.printHex(xbeeZB.channel);
  //USB.println();

}
